#include "asuro.h"
#include "Nuetzlichefunktionen.h"

int main(void) {
	Init();
	EncoderInit();
	EncoderStart();
	int d = 1630;

//	for (d = 1550; d <= 1650; d += 10) {
	StatusLED(GREEN);
	speedControl(d ,200,300);
	StatusLED(YELLOW);
	speedControl(d ,300,200);
	StatusLED(RED);

	Msleep(2000);
//	}

/*	int d = 400;
	int l = 300;
	int r = 300;

	for (d = 1200; d <= 1200; d += 100) {
	for (l = 400; l <= 700; l += 50) {
	//for (r = -200; r <= 200; r += 100) {
		SerPrint("### speedControl distance - lSpeed - rSpeed: ");
		PrintInt(d);
		SerPrint(" ** ");
		PrintInt(l);
		SerPrint(" ** ");
		PrintInt(l);
		SerPrint(" ###\r\n");


		StatusLED(GREEN);
		speedControl(d ,l, l);
		StatusLED(RED);
		Msleep(10000);
		StatusLED(YELLOW);
		Msleep(1000);

//	}
		}
	}*/
	while (1)
		;
	return 0;
}
